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Abstract —The Mahalanobis distance is commonly used in 
multi-object trackers for measurement-to-track association. 
Starting with the original definition of the Mahalanobis distance 
we review its use in association. Given that there is no principle 
in multi-object tracking that sets the Mahalanobis distance 
apart as a distinguished statistical distance we revisit the global 
association hypotheses of multiple hypothesis tracking as the 
most general association setting. Those association hypotheses 
induce a distance-like quantity for assignment which we refer 
to as association log-likelihood distance. 

We compare the ability of the Mahalanobis distance to the 
association log-likelihood distance to yield correct association 
relations in Monte-Carlo simulations. It turns out that on 
average the distance based on association log-likelihood per¬ 
forms better than the Mahalanobis distance, confirming that 
the maximization of global association hypotheses is a more 
fundamental approach to association than the minimization of 
a certain statistical distance measure. 

I. INTRODUCTION 

In multi-object trackers where probability distributions of 
individual tracks are filtered new sensor measurements need 
to be assigned to already existing tracks (or used for object 
initialization) before the filter update can be performed. 
This requires association, i. e. the establishment of relations 
between filtered, predicted tracks and sensor measurements []] 
Despite of the many different aspects and techniques of 
association such as one-to-one versus one-to-many or single¬ 
scan versus multi-scan association it always involves the 
establishment of global association hypotheses and the opti¬ 
mization with respect to hypothesis probabilities. In single¬ 
scan association this turns out to be equivalent to computing 
a measure of distance between tracks and measurements and 
minimizing the “cost” of association by minimization the 
sum of those distances. In this paper we provide a com¬ 
plete derivation of single-hypothesis assignment from global, 
joint association events which induces a distance measure 
for assignment algorithms. We then compare this distance 
measure with the well-known Mahalanobis distance which 
is commonly used for measurement-to-track association, see 
e. g. [2], [3], [4], [5], 

Distance measures for measurement-to-track association 
for multi-object tracking that are variants (depending upon 
the track life cycle assumptions) of the logarithm of the 
association likelihood have been presented in [6]. In [7] the 
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'Association is not necessary in approaches where multi-object distribu¬ 
tions are filtered and tracks are identified and extracted after filtering (see 
e. g. HI). 


association log-likelihood distance (referred to as matching 
likelihood) was compared to the Mahalanobis distance in the 
context of data association for SLAM. The authors’ main 
point is that the association log-likelihood should be used 
instead of the Mahalanobis distance. While we agree with 
this statement, we believe that for a proper derivation of the 
association log-likelihood distance for data association one 
must start with the correct expression of the probability for 


the global joint association event as explained in section III 


The two main contributions of this paper are: 1. a com¬ 
plete derivation of the association log-likelihood distance for 
measurement-to-track association starting from first princi¬ 
ples, and 2. a comparison of association performance using 
the association log-likelihood distance and the Mahalanobis 
distance in the context of multi-object tracking. 

This paper is organized as follows: first we revisit the 
origin of the Mahalanobis distance and its use in asso¬ 
ciation. We then review global association hypotheses of 
multiple hypothesis tracking and show how they naturally 
lead to a distance-like measure for assignment (association 
log-likelihood distance) which is similar but not identical 
to the Mahalanobis distance. By performing Monte-Carlo 
simulations with both the Mahalanobis distance and the 
association log-likelihood distance we compare their efficacy 
in obtaining correct association relations. 


II. The Mahalanobis distance and its role in 

ASSOCIATION 

The Mahalanobis distance was proposed in 1936 [8] in 
connection with hypothesis testing to assess the distance]]] 
between two probability distributions with a common co- 
variance matrix E but different means //. ], fx- 2 

d 2 Maha (Ml, M2, £) = (Ml ~ S _1 (Ml ~ M 2 ) (1) 

It is also used to compute a distance between a sample s (or 
a sample mean) and a distribution characterized by the mean 
vector [j. and covariance matrix E 

dhaha 0,M,^) = 0-M) T £ _1 (s-M) (2) 

It is easy to show (see e. g. [9]) that if x is an n-dimensional 
random Gaussian vector with mean fi and covariance matrix 
E then d 2 Maha (x, /i, E) is distributed according to a xii~ 
distribution which enables hypothesis testing with the chi- 
square test. 


2 As in the original paper we use the term distance and not distance 
squared. 



In track-to-track fusion this distance definition is often ex¬ 
tended to a distance between two distributions with different 
covariance matrices (/ii,£i), (/x 2 ,£ 2 ): 

aha (/H, ^2, S) = {/lx - S 1 (/H — H 2 ) 

i 

^M ff aTa(A t l’^l>A t 2>^' 2 ) = (Ml - M2) T (^1 + S 2 ) 1 (/H - /i 2 ) 

in order to provide a distance measure for association be¬ 
tween two independent tracks, see e. g. [10]. 

The Mahalanobis distance is commonly used for 
measurement-to-track association: the expected measure¬ 
ment z(k) at time k given the predicted state £“ and 
the white, Gaussian measurement noise r is (measure¬ 
ment/output model) 

z(k) = h(£~{k))+r{k) (3) 

Then the probability density function (pdf) of z using lin¬ 
earization is given by Af(z\HP~H T + R) where 
H = d^h is the linearization of the measurement/output 
function h(.) with respect to the state, and P~ and R are 
the covariance matrices of £“ and r, respectively. Hence the 
Mahalanobis distance between a measurement sample 2 and 
its predicted distribution is 

d 2 Maha (z,h(C),HP~H T +R) (4) 

In nearest-neighbor, single hypothesis association a matrix 
with distances between all tracks and measurements is 
computed which is then passed to an assignment algorithm 
such as the Munkres [11] or the auction [12] algorithm. 
On the other hand has it been recognized that association 
using the Mahalanobis distance is not optimal since large 
uncertainties, i. e. large covariance matrices, could lead 
to very small distances; in particular an uncertain track 
with large covariance matrix could “steal” a measurement 
from another track whose difference of the means is much 
smaller than the one from the uncertain track, see [13], [7]. 
The complementary situation is depicted in fig. [T] where 
an uncertain measurement (measurement 2) has a smaller 
Mahalanobis distance to the track than measurement 1 which 
has a smaller covariance and whose mean is closer to the 
track. This effect relies on different covariance matrices for 
different measurements - while this seems to be unusual for 
landmark measurements in SLAM [7] this is common in 
multi-object tracking. 

Therefore, in the next section we will derive the associa¬ 
tion log-likelihood distance - different from the Mahalanobis 
distance - used for assignment starting with the probabilities 
for joint association events as used in multiple hypothesis 
tracking (MHT). MHT is considered here as the most general 
case as it encompasses false detections/false tracks as well 
as new tracks. 

III. Deriving single-hypothesis assignment from 

JOINT ASSOCIATION EVENTS 

Starting with the joint association probability used 
for MHT (see [14], [15]) we show how the individual 



x[m] 


Fig. I. “Stealing” of track: measurement 2 has a large covariance matrix 
and hence a smaller Mahalanobis distance to the track than measurement 1 
despite the fact that the mean of measurement 1 is much closer. Using the 
Mahalanobis distance would lead to an association between measurement 
2 and the track, whereas using the association probability distance would 
lead to an association between measurement 1 and the track. 

measurement-track hypotheses (measurement belongs to an 
existing track, existing track is not detected/observed, mea¬ 
surement belongs to a non-existing track - i. e. a false 
measurement, measurement belongs to a new track) can be 
cast into a matrix form suitable for application of single¬ 
hypothesis (zero scan) assignment algorithms. This amounts 
to a pruning of all but the most probable hypothesis at every 
scan. 

The probability of the joint association event 6{k) (at time 
fit) for MHT with the number of false measurements and the 
number of new tracks given by Poisson distributions reads 
[14], [15] 

Not 

P(o(k)\z k ) = - Y[ P (z ji (k)\d Jtl (k),z k - 1 ) p D (cr(fc)) 

C i=1 

n t 

• n ( 1 -ms-w)) 

i=NDT +1 

Ndt+Nfd 

n PFD{Zj{k)) 

j = NDT +1 
No 

n PNT(Zj(k )) (5) 

j=N DT + N FD + 1 

where c is a dimensional normalization constant and the 
other symbols are explained in table [T] Instead of using 
binary index variables that depend upon Q(k) as in [14], [15] 
we assume here that the tracks have been ordered (detected 
tracks, missed tracks) as well as the detections/measurements 
(detections of tracks, false detections, new detections). Be¬ 
cause of the subsequent restriction to single-hypothesis as¬ 
signment we have omitted the recursion with respect to the 
joint cumulative event 0 fc_1,s . 

By setting the number of new tracks to zero: A’^r = 







TABLE I 

Glossary for joint association probability 


symbol 

explanation 

Nt 

number of established tracks at £fc i 

Not 

number ot established tracks detected 

at tfc 

N d 

number of detections/measurements at 

N F d 

number of false detections at 


association event that measurement ji 
originated from track i 

pd (er(*)) 

probability ot detection ot track i with 

predicted state (k) 

Pfd ( zj(k )) 

probability density ot a talse detection 

at Zj (k) (parameter from Poisson dis¬ 
tribution) 

0NT (+ (&)) 

probability density ot new track ap¬ 

pearance at Zj(k) (parameter from 
Poisson distribution). Here, as in [14], 
the probability of detection Pjj has 
been included in j3 nt • The number of 
new tracks is Nnt = Nd — Nt>t~ 
N F n- 


association probability density ot a 

measurement ji given its origin 
i: AT{zj i ; h(tn, H T P-H + R n ), 
see Appendix IB] 


0 => Np>p + Npr = Np, the expression 0 reduces to 
the joint association probability of JPDA [15]. Since we 
are not interested in maintaining several hypotheses over 
time but want to pick the most probable joint hypothesis 
in every scan in a computationally efficient way, we want 
to cast the individual hypotheses in a form suitable for 
existing, efficient assignment algorithms that put the global 
association hypotheses in order and/or find the hypothesis 
with the maximal probability. We first apply the logarithm 
to this joint probability density in order to turn products 
into sums. However, this requires dimensionless probabilities 
and not probability densities. Hence we multiply probability 
densities with an arbitrary measurement volume V z . This will 
not alter the result of the ordering of the hypotheses. Then the 
logarithmized probabilities can be cast into a square matrix 
a as follow^] (probability arguments have been omitted): 

a = (6) 


detections one obtains (1 + 2-2)! = 120 hypotheses of 
which only eight are distinct, see eq. 0. By subtracting 
ln(l — Pp>) from the first Np columns a matrix with zero 
entries in the last N T + Np, rows is obtained. Now the 
contribution of independent elements from the last Np + Np, 
rows to global hypotheses is zero. Truncating the matrix 
by removing those last Np + Np> trivial rows and making 
the non-diagonal entries of {In (PfdVz)} and {In ((3ntV z )} 
forbidden leads to a smaller, rectangular Np, x (Np + 2 Np,) 
matrix with 


min(N D ,N T ) No —Not 

E E 

Njjt—O Nfd —0 



/ N d — N dt \ N t \ 

V Nfd ) (Np — Np,p)\ 


(7) 

distinct hypotheses. The resulting hypotheses are identical to 
eq. 0 except for a common factor which is irrelevant for 
the ordering of the hypotheses. 

For the remainder of this paper we focus on the orig¬ 
inal matrix 0. The matrix entries are the logarithmized 
association probabilities between tracks (existing, false, new) 
and measurements (existing, non-existing). In particular, the 
logarithmized association probability between an existing 
track i and an existing measurement j reads 


= In (A HP~H t + Rj)V z ) + In (P D ) 


1 


(- 


V~ 


= —A z^i E A , A za + In , __ 

2 31 A ~- 3 Vv^tEa: 


In (Pd) 


where A+, = Zj — h{^~) and T,^ Zji = HP~H T + Rj. 

Multiplying the matrix 0 by —2 turns maximization of 
the sum of independent matrix entries into minimization; 
choosing V z = 1 • units(V z ) yields the following expression 


rl 2 

U'Asso—LLJi 


— 2 CLji 


= A 2 + t E a {.. A^-i + ln - 


p-'Ai;,- 


units (V 2 ) 

~^Maha 

+n In (2 tt) -2 In (P D ) (8) 


Detections 
1 ...N d 

Missing det. 

1... Nt 
Missing det. 
1 -ND 


Est. tracks False tracks New tracks 

1 ...Nt 1...Nd 1...Nd 

( {l n(p(-|-)KPD)} {1 il(/3fd 14)} {In {(3 NT V Z )} \ 

On (1- Pd)} {0} {0} 

V On (1- Pd)} {0} {0} 


The set of joint association probability logarithms consists of 
all ( Np+2Np>) \ sums of matrix entries that are independent^] 
This is the form required for assignment algorithms such 
as the Munkres algorithm. However, this is not an efficient 
way of representing hypotheses as it leads to many identical 
hypotheses. For example for one established track and two 


3 The last Np> rows are necessary to make the matrix square so that for 
each of the first Np columns an independent element must be picked. 

4 A set of elements of a matrix are said to be independent if no two of 
them lie in the same row or column [11], 


whose first term is the Mahalanobis distance and where 
n = dim(A 2 :). We refer to d 2 Asso _ LL as the association 
log-likelihood distance because p ( 2 + (k)\dj i i(k), Z fc_1 ) is 
conditioned on the association event 0 Jri . Setting Pp> = 1 
gives the logarithm of the probability density of the predicted 
measurement. Note that in settings where sensor models 
with different dimensions n are used at the same time the 
term nln(27r) will have an influence on global association 
hypotheses. 

Using this association probability distance tracks or mea¬ 
surements with large covariances are penalized in association 
with respect to tracks with small ones, see fig. [2] thereby 
avoiding the situation depicted in fig. [T] where a rather un¬ 
certain track with large covariance has a smaller Mahalanobis 
distance to the measurement than a second track whose mean 
is much closer to the measurement. 
























Fig. 2. One-dimensional generalized Mahalanobis and association log- 
likelihood distances as a function of the sum of variances, with A z = 0.7m. 

The association distance 0 can hence be derived from 
first principles - in particular the term In | Ea^, need not 
be viewed as a heuristic distance penalty [13], [16]. 

- Relation to results presented in [7]: As mentioned in 
the introduction the case for the association log-likelihood 
distance compared to the Mahalanobis distance has been 
made in [7]. However, their expression for the probability 
of the joint association event is different from the one 
used here (eq. 0> see also [14], [15]). In particular note 
that P(0{k)\Z k ) = P(6(k)\Z(k), Z k_1 ) depends upon the 
history of all current and past measurements. This is not 
equal to 

P(e(k)\Z(k),{C(k)}) (9) 

where {£“(&)} denotes the set of Nt established, predicted 
tracks at time k. The difference is that by conditioning 
on tracks instead of measurements the track estimation 
uncertainty subsumed in its covariance matrix is missing. 
Indeed, using the probability (|9]) the factors of the likelihood 
function of 9(k) on the right-hand side of eq. 0 change: 

P ( Zji {k)\euk),z k - 1 ) 

= p (^iO)IC r 0)) 

^ J\f{z jt (k) ; H£~ (k), HPr H T + R jt ) 

Therefore expression (|9]> as well as the analogous expression 
in [7, eq. 1] should not be the starting point for deriving an 
association distance^ 

IV. Comparison of distances 

Despite evidence for the association log-likelihood dis¬ 
tance detailed above the Mahalanobis distance has also been 

5 However, the authors arrive at the correct result by equating 
V (zu (*0l%»i(*0, {£-(*)}) to M(z u (k)-, H£7(k), HP~H f + R ji ) in 
[7, eq. 2] instead of M[zj i (fc); H(~ (fc), Rj i ). Here, we have translated 
their expressions into the analogous ones in our notation. 


commonly used for association (see e. g. [2], [3], [4], [5]). 
This motivates our investigation how the association log- 
likelihood distance compares with the Mahalanobis distance 
with respect to their performance in association: 

d Maha( S >M> E ) = 0 - p) T S" 1 (s - p) 

d 2 Asso-LL( s iP^) = 0 - p) T S" 1 (S - p) 


units (|£|) 

+n In ( 27 t) — 2 In (P D ) (10) 

We want to compare the efficacy of the distances listed 
above in making correct measurement-to-track associations. 
We focus on a single-scan, single time-step set-up. For each 
time-step we create N ground truth tracks of the form 

,i = 1 (see ( fl2| ) in a certain state space volume 

using a uniform distribution. Then we draw N samples for 
current measurements from A f(zp, h(£i), Ri) and N current 
estimated predicted states from A f(£f ; f , P~) where the 
expressions for the covariance matrices Ri and P~ are 
obtained as detailed below. The optimal Munkres association 
algorithm is used to find the best association between these 
measurements and predicted tracks using the distance matrix 
created by the respective generalized distance. This set-up 
enables us to cleanly separate the influence of the used 
association distance on assignment from the specifics of 
tracking and track management, in particular we do not 
simulate tracks over time in their life cycle stages (initialized, 
under test, established, ...) and set Pjj = 1. 

The performance of the association algorithms is evaluated 
at three levels of track separation, i. e. number of tracks 
N £ {10,30,50} in a given state volume, and with two 
different measurement models specified in eq. Also, in 
order to incorporate the effect of the track life cycle stages 
on the state covariance we investigate two extreme cases: 

a) State covariance matrix from steady state: For every 
ground truth track i we generate its estimated predicted co- 
variance matrix P~ x at steady state by using the dynamical 
system specified in Appendix [A] where the process noise 
covariance matrix V} and the measurement noise covariance 
matrix if, are used as input for the discrete algebraic Riccati 
equation: 

P~ = FP~ F t 
1,00 1,00 

-FPr H t (HPrH r + f?,)" 1 HP~F r 

+GViG r (11) 

Then, the estimated track state mean £“ is obtained as a 
sample of Pf^ )- The measurement z, is obtained 

as a sample of A f{zi\ Ri). The covariance matrices Vi 

and Ri are constmcted by a diagonal matrix with uniformly 
distributed positive definite entries which is then rotated with 
a uniformly distributed angle in [0, 27r]. 

b) State covariance matrix with arbitrary shape: While 
a multi-measurement, multi-track scenario at steady state is 
at one end of the spectrum of possible life cycle stages we 
also investigate a case where the predicted state covariance 









matrix is not at steady state but can assume an arbitrary 
shape. In this case, we construct P~ as V and R, above. 

The ground truth tracks were drawn from a state volume of 
Vj = [— 20m, 20m] x [—20m, 20m] x [—40m/s, 40m/s] x 
[—40m/s,40m/s]. The simulation was run in ten batches 
with 10000 association scenarios each; over those ten batches 
the deviation in the resulting percentage of correct assign¬ 
ments from the mean was less than 0.4%. 

The simulation results can be found in table [II] for the 
predicted tracks being in a steady state and in table [HI] for 
the predicted tracks with arbitrary covariance shape. In fig. 
[3] a simulation sample with TV = 30 tracks is shown. 
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Fig. 3. Error ellipses of measurements and predicted tracks of a sample 
simulation with TV = 30 tracks. 


Note that the proposed set-up assumes one global associ¬ 
ation hypothesis with the largest probability is picked - we 
do not maintain several hypotheses as in MHT. The creation 
of measurements for already existing tracks also means that 
we are restricting ourselves to the upper, left sub-matrix of 
eq. ^ with Np = Nt and Pjj = 1. 

TABLE II 

Correct assignment rate [%] for tracks in steady state 


TABLE III 

Correct assignment rate [%] for tracks with arbitrary 
covariance shape 


Number of tracks 
Distance\Output H 

N = 
Hi 

2 ^ 

N = 
Hi 

30 

h 2 

N 

Hi 

= 50 

h 2 

d 2 

a Maha 

72.3 

70.8 

39.2 

37.6 

25.9 

24.7 

d 1 . TT 

Asso—LL 

72.4 

70.8 

39.4 

37.8 

26.2 

24.9 


Next, we want to explore the influence of the term pro¬ 
portional to the measurement dimension n in d\ sso _ LL (10 1 . 
For tracks in steady state using II\ as measurement model 
we consider a scenario in which for some measurement-track 
pairs namely with j and i both odd, association 

is attempted with an only one-dimensional measurement 
defined by the first row of H\: Hu. For all other index 
combinations the full two-dimensional measurement with 
H i is used. In order to assess the influence of n ln(27r) 
we perform association with d 2 Maha and d 2 Asso _ LL as well 
as with the association log-likelihood distance without the 
nln(27r)-term: d 2 Asso _ LL - nln(27r). 


TABLE IV 

Correct assignment rate [%] for tracks in steady state with 

ONE- AND TWO-DIMENSIONAL MEASUREMENTS 


Number of tracks 
Distance\Output H 

N = 10 
Hi, Hu 

IV = 30 
Hi, Hu 

N = 50 
Hi, Hu 


72.1 

40.2 

27.4 

d' z 

a Asso-LL 

79.8 

53.4 

40.9 

d Asso-LL- nl < 2n ) 

79.0 

51.7 

39.2 


In table [Tv] we observe that the omission of the term 
proportional to the measurement dimension n ln(27r) does 
have a detrimental effect on the correct assignment rate. 
Also in this scenario with mixed measurement models the 
comparative advantage of d Asso _ LL with respect to d 2 Maha 
becomes larger compared to table [II] 

TABLE V 

Correct assignment rate [%] for tracks with arbitrary 
covariance shape with one- and two-dimensional 

MEASUREMENTS 


Number of tracks 
Distance\Output H 

N 

Hi 

10 

h 2 

N 

Hi 

30 

h 2 

N 

Hi 

= 50 

h 2 


79.3 

79.8 

49.8 

50.9 

34.5 

35.6 

d z 

a Asso-LL 

81.9 

82.3 

55.0 

56.0 

40.5 

41.5 


For tracks in steady state the association log-likelihood 
distance has a significant advantage with respect to the 
Mahalanobis distance. This advantage becomes larger (in a 
relative sense) as the number of tracks increases. The choice 
of measurement/output model //, has little effect on the 
assignment rate (table [U|. 

For tracks with an arbitrary covariance shape we do not 
observe significant differences between the association log- 
likelihood and the Mahalanobis distance. Again the choice 
of measurement/output model Hi has little effect on the 
assignment rate (table m- 


Number of tracks 
Distance\Output H 

N = 10 
Hi, Hu 

N = 30 
Hi, Hu 

IV = 50 
Hi, Hu 

d 2 

U Maha 

65.7 

32.6 

21.4 

Asso—LL 

73.2 

42.3 

29.4 

d Asso-LL -n\n{2-K) 

72.2 

40.7 

28.2 


Again, the omission of the term proportional to the mea¬ 
surement dimension nln(27r) has a detrimental effect on 
the correct assignment rate (table 0- Also, in contrast to 
the results in table [Till we observe a significantly better 


assignment rate using d 2 Asso _ LL as compared to d 2 Maha . 


V. Conclusions 

Starting with the probability density of the joint associa¬ 
tion event for MHT we have derived the association log- 
likelihood distance to be used in assignment algorithms. 















































Given the fact that the Mahalanobis distance is also com¬ 
monly used for assignment we have investigated both dis¬ 
tances in terms of their association performance by perform¬ 
ing Monte-Carlo simulations. In steady-state scenarios the 
association log-likelihood distance performed significantly 
better than the Mahalanobis distance. In scenarios with 
predicted track covariance matrices of arbitrary shape the as¬ 
sociation log-likelihood distance exhibited a better behavior 
when different measurement dimensions were present; when 
all measurements were two-dimensional the comparative 
advantage of the association log-likelihood distance over the 
Mahalanobis distance was within the statistical fluctuation of 
< 0.4%. 

In summary in this paper we have pointed out that the 
Mahalanobis distance has no special role in assignment algo¬ 
rithms and we have shown that the association log-likelihood 
distance is the one that can be derived from first principles in 
multi-object tracking. The association log-likelihood distance 
also performs significantly better in steady state scenarios. 
This supports our proposition that maximization of global 
association hypotheses is a more fundamental approach to 
association than the minimization of a certain statistical 
distance measure. 


Appendix 


A. Dynamical system 

The vehicle kinematics is characterized by a four¬ 
dimensional state vector 

£ = (x y x y) T (12) 

The dynamical model is a discrete-time counterpart white 
noise acceleration model [17] 


is given by a linear function h(£) = Hi ; where we investigate 
two different models 


H x 

H 2 


(1 0 0 0\ 
1^0 1 0 oj 
f 1 -1 0 0\ 
^0 1 0 oj 


(16) 


The measurement function is chosen to be linear in order to 
solve the Riccati equation for state-independent matrices. 


B. Conditional probability density of individual measure¬ 
ment 

The conditional probability of the measurement Zj. (k) 
given the set of previous measurements Z k ~ x and the 
event 9 3i , (k) as it appears in eq. (|5]l can be computed as 
follows for a linear system using Gaussian expressions for 
p{zj i {k)\9j i i(k),fi) and p (£i|2' fc_1 ) and using the Markov 
assumption: 

P {z j Xk)\e n ,{k),z k ~ 1 ) 

p (z 3t {k)\e ni (k), z k ~\^) P (&| e jii (k),z k ~ 1 ) d& 
p(^WI^iW,£i)p(£i|^ fc_ 1 )d£i 

R 3i )A/"(£*;£j - (k), P~ )d£i 
= A r( Zji (k)-,Hir(k),HPrH T + R jt ) (17) 



Alternatively, this as well as the expression for a nonlinear 
measurement function h: M{z 3i (k)\h{£~ (k)), HP~H T + 
Rj i ) can be derived by propagating the probability densities 
for and r through eq. 
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where 
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A o 

At k 

° \ 

0 1 

0 

At* 

0 0 

1 

0 

\0 0 

0 
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with At k = ffc+i — t k . The process noise v(k) is modeled by 
a white, mean-free Gaussian process with covariance matrix 
V(k). 

The sensor is modeled by a 2-D position measurement 
with 


z{k) = h(£ (k)) + r(k) (15) 


where z(k) is the measurement and the measurement noise 
r(k) is modeled by a white, mean-free Gaussian process with 
covariance matrix R(k). The measurement/output function h 
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